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1 TITLE OF THE^H^ENTION 

2 VEHICLE SURROUNDINGS MONITORING APPARATUS 
3 

Qjy^4 BACKGROUND OP THE INVENTION 
5 1. Field of the invention 

The present invention relates to a vehicle surroundings 
monitoring apparatus and more in particular to a vehicle 
surroundings monitoring apparatus suitable for detecting solid 
objects successively disposed along roads such as guardrails, 

10 side walls and the like. 

11 2. Prior arts 

With increased number of vehicles and with increased 
number of traffic accidents, the conception of Advanced Safety 
Vehicle (ASV) is becoming one of primary strategies in designing 
a vehicle. In particular, an ASV technology raises the 
intelligence level of a vehicle through the state of the art 
electronic technologies. In recent years, various safety devices 
such as issuing an alarm to inform a vehicle driver of a likelihood 
of collision, stopping a vehicle, decreasing or increasing the 
- 20 speed of the vehicle by detecting a vehicle traveling ahead or 
an obstacle through a television camera, a laser-beam radar or 
the like, have been proposed. 

The applicant of the present invention, in Japanese 
Patent Application Laid-open No. Toku-Kai-Hei 5-265547, have 
already disclosed a technique in which images taken by two 
stereoscopic cameras are transformed into distance images, these 
distance images being divided into lattice-like small regions 
at a prescribed interval to detect solid objects for each small 
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region. FurtW the applicant, in JapanesTpatent Application 
Laid-open No. Toku-Kai-Hei 6-266828, have already proposed a 
technique wherein similarly data of solid objects per small 
region are extracted, these data being processed by a so called 
"Hough- transformation method to detect the solid objects such 
as side walls and guardrails aligned along roads. 

However, according to these known arts, since the data 
of solid objects are processed by the "Hough" transformation 
method and the like, as a result, with respect to the solid objects 
provided along a curved road like guardrails, only their small 
portions located within a relatively short distance are 
recognized as straight lines, therefore it is much more difficult 
to recognize those objects in the distance. 

SUMMARY OF THE INVENTION 

The present invention is intended to obviate the 
aforesaid problem of the prior arts and it is an object of the 
present invention to provide a vehicle surroundings detecting 
apparatus capable of detecting a series of solid objects which 
constitute a boundary of a road as a wall surface even in case 
where the road is curved. 

In order to achieve the object, the present invention 
comprises a wall surface detecting means for dividing positional 
data of solid objects into groups and based on the grouped 
positional data of the solid objects for detecting a wall surface 
formed along a boundary of a road, a wall surface model forming 
means for interconnecting a plurality of nodes and based on the 
interconnected nodes for forming a wall surface model to express 



1 an outline o^e side wall and a wall *u r^e model correcting 
means based on the grouped positional data of the solid objects 
3 for correcting the wall surface model. 
4 
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BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is an overall view of a vehicle surroundings 
detecting apparatus mounted on a vehicle; 

Fig. 2 is a schematic block diagram of a vehicle 
surroundings detecting apparatus according to the present 
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10 invention; 

Fig. 3 is a first flowchart showing a flow of control 
of a solid object/side wall group detecting process; 

Fig. 4 is a second flowchart showing a flow of control 
of a solid object/side wall group detecting process; 

Fig. 5 is a third flowchart showing a flow of control 
16 of a solid object/side wall group detecting process; 

Fig. 6 is a flowchart showing a flow of control of a 
wall surface detecting process; 

Fig. 7 is a first flowchart showing a flow of control 
of a wall surface position correcting process; 

Fig. 8 is a second flowchart showing a flow of control 
of a wall surface position correcting process; 

Fig. 9 is an explanatory view showing an example of 
images taken by cameras mounted on a vehicle; 

Fig. 10 is an explanatory view showing an example of 

26 distance images shown in Fig. 9 ; 

27 Fig - 11 is an explanatory view showing the position 
of solid objects detected per respective strips; 



28 



3 



s s' 

fir 19 



^^^2 is an explanatory view> 



1 Fig.— x2 is an explanatory view, showing the' result of 

2 detection of side walls; 

3 Fig. 13 is an explanatory view showing the result of 

4 detection of side walls in terms of the X-Z plane; 

5 Fig. 14 is a schematic view showing a wall surface 

6 model; 

7 Fig. 15 is an explanatory view showing the way of 

8 searching a wall surface pattern; 

9 Fig. 16 is an explanatory view showing an example of 

10 a pattern of a weight coefficient; 

11 Fi 9- 17 is an explanatory view showing the result of 
^ 12 calculation of a degree of coincidence; 

X 13 Fi 9- !8 is an explanatory view showing the connection 

14 of nodes; 

15 Fig- 19 is an explanatory view showing the result of 
W 16 detection of wall surfaces; and 

£ 17 Fig. 20 is an explanatory view showing the result of 

fy 18 detection of wall surfaces in terms of the X-Z plane. 



20 DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

21 Referring now to Fig. 1, reference numeral 1 denotes 

22 a vehicle on which a vehicle surroundings monitoring apparatus 

23 2 is mounted for imaging objects within a visible scope ahead 

24 of the vehicle and for recognizing the objects for monitoring. 

25 The vehicle surroundings monitoring apparatus 2 comprises a 

26 stereoscopic optical system 10 for imaging objects from two 

27 different positions, an image processor 20 for processing images 

28 of these objects to obtain three-dimensional distance 



4 



1 distribution 




rmation, and a recognitioi^^udgmenf computer 




2 30 for detecting three-dimensional positions of roads and solid 

3 objects at high speeds based on the distance information inputted 

4 from the image processor 20, for identifying a preceding vehicle 

5 or an obstacle based on the result of the detection and for judging 

6 whether or not an alarm should be issued to avoid a collision 

7 with the preceding vehicle or the obstacle. 



9 sensors such as a vehicle speed sensor 4, a steering angle sensor 

10 5 and the like in order to detect a present traveling condition 

11 of the vehicle and also it is connected with a display 9 provided 

12 at the front of a vehicle driver for informing hazard. Further, 
Q 13 the computer 30 is connected with an external interface for 



iy 14 example for controlling actuators (not shown) which operate so 

m 

flg 15 as automatically to avoid a collision with the obstacle or the 

ry 16 vehicle traveling ahead. 



ry 18 pair of left and right CCD (Charge Coupled Device) cameras 10a, 

5; 19 10b. A pair of stereoscopic images taken by the CCD cameras 10a, 

20 10b are processed in the image processor 20 according to the 

21 principle of triangulation to obtain three-dimensional distance 

22 distribution over an entire image. 

23 The recognition/ judgment computer 30 reads the 

24 distance distribution information from the image processor 20 

25 to detect three-dimensional positions with respect to the 

26 configuration of roads and solid objects such as vehicles and 

27 obstacles at high speeds and judges a possibility of collision 

28 or contact with these detected objects based on the traveling 
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The recognition/ judgment computer 30 is connected with 
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The stereoscopic optical system 10 is composed of a 
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te^Wa by the vehicle speed sensor 4 



1 condition dete^md by the vehicle speed s en s ott 4 and the steering 

2 angle sensor 5 of the self vehicle to inform the vehicle driver 

3 of the result of the judgment through the display 9. 

4 Fig. 2 shows a constitution of the image processor 20 

5 and the recognition/ judgment computer 30. The image processor 

6 20 comprises a distance detecting circuit 20a for producing 

7 distance distribution information and a distance image memory 

8 20b for memorizing this distance distribution information. More 

9 specifically, the distance detecting circuit 20a calculates a 

10 distance to a given object by selecting a small region imaging 

11 an identical portion of the object from the left and right 
u 12 stereoscopic images taken by the CCD cameras 10a, 10b, 
W 13 respectively and then obtaining a deviation between these two 

14 small regions and outputs in the form of three-dimensional 

S3 15 distance distribution information. 

W 16 Fig. 9 shows an example of either of images taken by 

M- 17 the left and right CCD cameras 10a, 10b. When this image is 

!U 18 processed by the distance detecting circuit 20a, the distance 

Q 19 distribution information outputted from the distance detecting 

20 circuit 20a is expressed as a distance image as shown in Fig. 

21 10. 

22 The example of the distance image shown in Fig. 10 has 

23 a picture size composed of 600 (laterally) x 200 (longitudinally) 

24 picture elements. The distance data are included in white dotted 

25 portions that correspond to the portions having a large difference 

26 of brightness between two adjacent picture elements aligned in 

27 the left and right direction respectively in the image shown in 

28 Fig. 9. Further, in this example, the distance detecting circuit 
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^^distance image as an .im^5 



1 20a treats ^^distance image as an imW? composed of 150 

2 (laterally) x 50 (longitudinally) blocks, i.e., 4 x 4 picture 

3 elements for one block or one small region. The calculation of 
distance is performed for each block of the left and right images. 

The recognition/judgment computer 30 comprises a 
microprocessor 30a primarily for detecting the road configuration, 
a microprocessor 30b primarily for detecting solid objects based 
on the configuration of a road detected and a microprocessor 30c 
9 primarily for identifying a preceding vehicle or an obstacle based 

10 on the positional information of the detected solid objects and 

11 for judging a possibility of collision or contact with the 

12 preceding vehicle or the obstacle and these microprocessors 30a, 

30b, 30c are connected in parallel with each other through a system 
14 bus 31. 

09 15 Th e system bus 31 is connected with an interface circuit 

pj 16 32 to which the distance image is inputted from the distance image 
memory 20b, a ROM 33 for storing a control program, a RAM 34 for 
memorizing miscellaneous parameters produced during 
calculations, an output memory 35 for memorizing the result of 
processing, a display controller 30d for controlling the display 

21 9 and an I/O interface circuit 37 to which signals are inputted 

22 from the vehicle speed sensor 4 and the steering angle sensor 

23 5. 

24 As shown in Fig. 9, the distance image has a coordinate 

25 system composed of a lateral axis i, a longitudinal axis j and 

26 a vertical axis dp with an origin of the coordinates placed at 

27 the left below corner of the distance image. The vertical axis 

28 dp indicates a distance to an object which corresponds to the 
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1 deviation amount between blocks. Therefore, in the image 

2 processing computer 30, a point (i, j, dp) on the distance image 

3 is transformed into a coordinate system provided in the real space 

4 to perform processes such as recognition of the road configuration, 

5 detection of the position of solid objects and the like. 

6 That is to say, with respect to the three-dimensional 

7 coordinate system fixed to a self vehicle in the real space, 

8 setting X axis on the right side with respect to the traveling 

9 direction of the self vehicle (vehicle 1), Y axis in the upward 
direction of the vehicle 1 and Z axis in the forward direction 

11 of the vehicle and placing an origin of the coordinates on the 

_ 12 road surface underneath the center of two CCD cameras 10a, 10b, 

m 13 X-Z plane (Y = 0) coincides with the road surface, if the road 

FU 14 is flat. Accordingly, the point (i, j, dp) on the distance image 

w 15 can be transformed into a point (x, y, z) in the real space as 

W 16 follows: 

M 1 17 x = CD / 2 + z • PW • (i - IV) (1) 

n s 

Hi 18 y - CH + z • PW • (j - JV) (2) 

Q 19 z = KS / dp (3) 

.-■~JL 

20 where CD is an interval between CCD cameras 10a # 10b; PW is an 

21 angle of visibility per picture element; CH is a height of CCD 

22 cameras when measured from the road surface; IV, JV are 

23 coordinates of an infinite point directly in front of the vehicle 

24 1 on the image; and KS is a distance coefficient (KS - CD / PW) . 

25 Rewriting the above equations (1), (2) and (3) as 

26 follows: 

27 i - (x -CD / 2) / (2 • PW) + IV (4) 

28 j - (y - CH) / (z ■ PW) + JV . ... (5) 
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1 dp = KS / z ■...-.( 6 ) 

2 Next, processes in the recognition/ judgment computer 

3 30 will be described. 

4 In the microprocessor 30a, first, actual lane markers 

5 of a road are extracted from three-dimensional positional 

6 information contained in the distance image which is stored in 

7 the distance image memory 20b and then the configuration of the 

8 road is recognized by modifying parameters of a built-in road 

9 model so as to agree with the actual road configuration. 

10 The road model described above is expressed by a 

11 plurality of three-dimensional linear equations. That is, the 

12 imaged left and right lane markers of the road on which the subject 
2 13 vehicle is traveling are divided into a plurality of intervals 
5Jj 14 determined according to distance and the road model is formed 
2 15 by a plurality of broken lines each of which is expressed for 
fU 16 every interval in the following, three-dimensional linear 

2 

H* 17 equations: 

fUi8 x = a • z + b ^ 



□ 19 y = c ' z + d .... (8) 

20 where a, b are parameters of a linear equation extended in the 

21 horizontal direction in the coordinate system of the real space 

22 and c, d are parameters of a linear equation extended in the 

23 vertical direction in the coordinate system of the real space. 

24 In the microprocessor 30b wherein the detection of 

25 solid objects is processed, the distance image is divided into 

26 lattice-like strips having a prescribed interval and data of 

27 solid objects are extracted for every strip. Then, a histogram 

28 is produced per each of these strips based on the data of solid 
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objects and the position on the X-Y plane of solid objects 
representing respective strips and the distance thereto are 
obtained from the histogram. Then, comparing the image 
successively from the left to the right, the images having close 
distances in the forward and backward direction (Z-axis 
direction) and the lateral direction (X-axis direction) are 
classified into the same group. Further, when the arrangement 
direction of the data is checked, the portion where the 
arrangement direction is largely changed is found, the group 
being divided in a different group. 

P tirhhnr r hnrnrt nn Mip arra ngement dirprhinn nf _ 
distance data of the overall groups, i.e., the^g-r^xtieirt with 
respect to the Z-axis, the groups are cla^sd^ied into solid object 
groups or side wall groups. the solid object groups, 

parameters such as a mean^dl stance, X coordinates of the left 
and right ends and the IdJce are calculated from the distance data 
of the group. Fur^Ker, for the side wall groups, parameters such 
as the arranger^nt direction (gradient with respect to the Z-axis) , 
the positions of the forward and backward ends in terms of Z-X 
coordinates and the like are calculated. Thus, the front end, 
the side surface and the rear end of a solid object and the 
stryfcture such as a guardrail are detected as the side wall 
a&zan&ea aiong tire^-road-*^ 

With respect to the generation of distance image, the 
process of detecting the configuration of roads from the distance 
image and the process of the judgment of collision or contact 
with obstacles, details of which are described in Japanese Patent 
Application Laid-open No. Toku-Kai-Hei 5-265547 and No. 
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1 Toku-Kai-Hei 6-266828 .both -of which have been proposed by the 

2 applicant of the present invention. 

3 The present invention is characterized in that even 

4 when the road is curved, the wall surface can be recognized up 

5 to the far distance along the curved road. The process in the 

6 microprocessor 30b will be described according to the flowcharts 

7 shown in Fig. 3 through Fig. 8. 

8 The yiuyiams shuwir - in Figs 3 thr o ugh 5 ar e- on afi-^<>r - 

9 classifying the solid object group aj^d^tKe^ide wall group by 
processing the distance daj^obtained from the distance image. 

11 First, at a step^S-ftfl, the distance image is divided into 

12 lattice -like^£rips having a given interval (for example 8 to 

13 20 picture elements) and at S102 data of a solid object are 

14 extracted for every strip and the data of the first strip are 



15 v&3t€r- txr^calculate the distance to tKe" ob jecTT 

16 Next, the program goes to S103 where the data of the 

17 first strip are set and at S104 the three-dimensional position 

18 (x, y, z) of the object is obtained according to the aforesaid 

19 equations (i) to (3) . Then, the program goes to S105 where the 

20 height yr of the road surface at the distance z is calculated 

21 according to the linear equations (7) and (8) expressing the road 

22 configuration. In case where the road configuration can not be 

23 recognized for example on a road having no lane marker, the road 

24 surface being assumed to be in a horizontal relation with the 

25 vehicle 1, the road height is established to be zero for example. 

26 Next, the program goes to S106 where the data above 

27 the road surface are extracted as the solid object data based 

28 on the height H from the road surface which is calculated according 
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no object, th^Erequency is relatively • small . 

Accordingly, it is permissible to judge that if the 
frequency of the histogram exceeds a predetermined threshold 
value and besides shows a maximum value in an interval, an object 
exists in the interval and that if the maximum value of the 
frequency is below the threshold value, no object exists. Even 
in case where some amount of noises are included in the image 
data, it is possible to detect an object with minimum effect of 



9 noises. 
10 



After that, the program goes from Sill to S112 where 
it is checked whether or not the process has reached a final strip. 
If it is judged that the process has not yet reached a final strip, 
g 13 the program returns to S103 and similar processes are repeated. 
fW 14 When the process reaches the final strip, the program goes from 
09 15 S112 to S114. 

^ 16 Fi 9- 11 is a view showing the position of solid objects 

2 

17 detected for each strip from the original image. The distance 
data of these solid objects are classified into groups having 
a close distance with each other by the processes executed at 

20 the steps S114 to S120 . The grouping will be performed as follows . 

21 In these processes, the detected distances of the solid objects 
in respective strips are investigated. If the difference of the 
detected distances to the solid objects between adjacent strips 

24 is smaller than a threshold value, these objects are deemed to 

25 be the same objects and on the other hand, if that difference 

26 exceeds the threshold value, those objects are regarded as 

27 different objects. 

28 Specifically, at S114, the first strip (for example, 
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rhe left end) is investiaated- and i 



1 a strip of theTeft end) is investigated- and if a solid object 

2 is detected therein, the distance data are read and this strip 

3 Rl is classified into a group Gl having a distance Zl. Next, the 

4 program goes to S115 where the right adjacent strip R2 is 

5 investigated. If no solid object is detected in the strip R2, 

6 it is judged that the group Gl exists within the strip Rl or in 

7 the neighborhood thereof and the distance is Zl. On the other 

8 hand, if a solid object is detected in the strip R2 and the distance 

9 to the object is Z2, the distance Zl of the strip Rl is compared 

10 with the distance Z2 of the strip R2 . 

11 After that, the program goes to S116 where it is judged 
^ 12 whether or not the difference between the distances Zl and Z2 
q 13 is smaller than a threshold value and if the difference is smaller 

14 than the threshold value and is close to each other, it is judged 

J£f 15 a t S117 that the solid object detected in the strip R2 belongs 

^ 16 to the same group Gl to label as such and then the program goes 

jJJ: 17 to S119. At this moment, the distance to the object is established 

Ijf 18 to be a mean value of Zl and Z2 . 

O: 19 On the other hand, in case where the difference of the 

20 distances Zl and Z2 exceeds the threshold value, the program goes 

21 from S116 to S118 in which, judging that the solid object detected 

22 in the strip R2 does not belongs to the group Gl, the solid object 

23 is labeled as belonging to a new group G2 having a distance Z2 

24 and then goes to S119. 

25 At S119, it is investigated whether or not the process 

26 has reached a final strip and if not, after the distance of the 

27 next strip is read at S120, the program returns to S115 and further 

28 the right adjacent strip is investigated. If the process has 
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reached the fWSl strip, the program goesTrom S119 to S121. 

The following case should be noted. Assuming the 
situation where a vehicle parks beside a guardrail, there is a 
possibility that the distance data of the guardrail are deemed 
to belong to the same group as the distance data of the parked 
vehicle, in order to avoid this, the arrangement direction of 
the distance data is checked on the X-Z plane through the processes 
at S121 to S131 to divide the group of the arrangement direction 
into a portion in parallel with z-axis and a portion in parallel 
with X-axis. 

Tlia * - j n< n f f71? l thp r1n1-.a __of the fir st grou p »-r» 
and at S122 the arrangement direction of the data of. 
strips is calculated. Further, at S123 the>e-s~trips are labeled 
as "object" or "side wall", respectively. Specifically, first 
two points on the X-Z plane are picked up from the data of the 
first group. One point Vtf, zi) is a middle point of a strip Kl 
at the left end of tfte first group and the other point (Xp, Zp) 
is a middle poin*' of a strip far away from the left end strip 
Kl by an internal of N strips in the right hand direction. Then, 
a line connecting these two points is drawn on the X-Z plane and 
a gradie/t Al of the line is calculated. When the gradient Al 
is comcfared with a prescribed value, for example 45 degrees, if 
the gradient Al is larger than the value, the strip Kl is labeled 
asy^side wall" and if the gradient Al is smaller than the value, 

4 • The ^^AsefrtrrKatN^ 1 , namely, an adjacent strip may produce 
ftuations in tne arrangement directioir 
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difficult to make discrimination ^bet^^^^ and 
Therefore, it is suitable^sT^oT an adjacent strip, but a 
strip a littledis^ant. Hereinafter, the labeling of "side wall" 
or "object is performed successively f.om the left end strip 
up toXe stri* apart by n strips ori the left side of the right 



- Wh* n t - ho lab elin g U a tLu mpliahed lui each stnj 
the group, the program goes from S123 to S124 j^ere^thTTabel 
of the left end strip is read and at thenex-t^p^i 25 , the label 
of the right adjacent strip is^ead^en, it is investigated 
whether or not the label of^Tfef t end strip is different from 
that of the right ad^acW strip. As a result, if the label of 
the left end stripes the same as that of the right adjacent strip, 
the progranyskips to S128 and if different, the program steps 
to S127^where the strip labeled "side wall" and the strip labeled 
"object" are divided into different groups respectively. The 
div/sion of the group is performed at the position apart by N/2 
s/rip on the right side of the position where the label changes 
gpnLJls. i d 0 wall" t o-i^ e r t- a n d vico vc r 3a> 

in this case, to avoid the situation where the label 
itself is erroneously labeled due to the dispersion of distance 
data, the division is performed only when more than three same 
labels are successive. 

At S128, it is checked whether or not the process comes 
to the final strip and if not, after reading the label of the 
next strip at S129, the program returns to S125 and hereinafter 
similar processes are repeated. When the process comes to the 
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final, stri^^ program goes from S128^si30 where it is 
investigated whether or not the process reaches the final group. 
When the process does not yet reach the final group, the data 
of the next group are read and hereinafter the same processes 
are carried out repeatedly. When the process reaches the final 
group, the division of the groups is completed and the program 
goes from S130 to S132. 

following ot-e p s -. fl-n? fn S137 aro of piuu 
which further classifications of "side^H» or "object" are 
carried out to raise th^ac^u^iToTuie classification performed 
at S127. After th^-datTof the first group are read at S132, at 
S133 approximate straight lines are obtained from the positions 
(Xi\X) within the group according to the Hough transformation 
o/ the linear square method to calculate a gradient overall the 



T hen, the pi - o g mm goca Lu S131 where the group i^, 
reorganized such that the group having a gradient ir^ined toward 
X-axis is classified into the "obj ect" grpup^and the group having 
a gradient inclined toward Z-axjUrtT classified into the "side 
wall" group. Further, at^fs, miscellaneous parameters of the 
group are calculated^ with respect to the group classified 
"object", theseplrameters include an average distance which is 
calculated f*6m the distance data within the group, X-coordinates 
at the left and right ends. of the group and the like and with 
respecl/to the group classified "side wall", those parameters 
include an arrangement direction of the data (gradient with 
pect to Z-axis), Z, X coordinates of the front and rear ends 
■group and the like. In tTmreTnbi^dltneftt^^ 
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fefee— a:ccugacy-^K__ cias,sification, th< 



4 

5 
6 
7 
8 



2 accordlngj^he^^^ gradient of the overall group, however 

Further, the program goes from S135 to S136 where it 
is judged whether or not the process has reached the final group. 
If it is not the final group, the program goes back to S137 in 
which the data of the next group are read and returns to S133 
to repeat the same processes. When the process has reached the 
9 final group, the program leaves the routine. 

10 Fi 9- 12 shows a result of the detection of the side 

11 wall . When the data of the groups are illustrated on the X-Z plane, 

12 as shown in Fig. 13, they are recognized as "side wall" groups. 

13 in this case, portions along a curved road are not recognized. 

14 The program shown in Fig. 6 is for recognizing the wall surface 

15 along the curved road using the data of the "side wall" group 

16 obtained by the program described before. 

17 First, at S201, groups estimated to be a wall surface 

18 are selected from the groups classified "side wall" and at the 

19 steps after S202, a wall surface is searched based on the data 

20 of the "side wall" groups using the following wall surface model . 

21 The wal l surface model is shown in Fig. 14, in which 

22 the wall surfaces are expressed as border lines connecting between 
nodes provided at a specified interval within a given range. For 
example, the border line is constituted by 41 nodes arranged at 
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25 an interval of 2 meters within an range from 10 to 90 meters ahead 
of the self vehicle. Respective nodes have successive reference 

27 numbers starting from the self vehicle side. The Z-coordinates 

28 of the respective nodes are fixed with respect to the vehicle 
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1 position an^lx-coordinates thereof are^termined according 

2 to the procedure which will be described hereinafter. 
At S202, a node N 8 corresponding to an end point on the 

vehicle side of the selected side wall group is established based 
on the z- coordinate of the end point and the X- coordinate of the 
node N 8 is established being adjusted to the X-coordinate of the 
end point. Next, the program goes to S203 where the next node 
N..i is established in the direction of the gradient of the side 
wall group. Next, when the node N e -i (U2) is determined, its 
direction is established along a direction of the second previous 
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Then, the program goes to S2 04 where, as shown in Fig. 
15, the position of the wall surface is searched by a so-called 
"pattern matching" within a specified searching range to extract 
| 15 a solid object P t for every strip within the searching range. For 
pj 16 example, the searching range in the X-axis direction has ± 3 to 
^17 5 meters in the X-axis direction and ± 1 meter in the Y-axis 
direction with its center placed at a coordinate (X no . i( Z nst i)of 
19 the node N s+i established at S203. 

The matching of the wall surface pattern is performed 
to the solid object Pi within the searching range. Fig. 16 shows 
an example of the wall surface pattern (weight coefficient 
pattern) used for the pattern matching. The wall surface pattern 
shown in Fig. 16 is a pattern for the wall surface on the left 
side and a symmetric pattern to this pattern is used for the wall 
surface on the right side. The lateral axis of this wall surface 
pattern coincides with the distance in the X-axis direction and 
the longitudinal axis indicates a weight coefficient. A maximum 
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egW6 of coincidence is sear-chCTTw: 



1 point of a degW of coincidence is sear-chSFwhile the central 

2 point of the wall surface pattern is shifted towards the X-axis. 

3 Specifically, as shown in Fig. 17, a weight Wi is obtained with 

4 respect to the deviation of the solid object Pi in the X-axis 

5 direction from the central point of the wall surface pattern to 

6 calculate the sum of the weight Wi as a degree of coincidence F. 

7 Further, when the degree of coincidence F becomes maximum, the 

8 position of the central point of the wall surface pattern is 

9 recognized as a wall surface. When the maximum value of the degree 
of coincidence F is smaller than a threshold value, it is judged 

11 that there is no wall surface. 

12 When the process of the step S204 finishes, the program 
Q 13 goes to S205 at which a X- coordinate X p „ of the central point of 
pj 14 the wall surface pattern at the maximum point of the degree of 

m 15 coincidence F, is established as a X-coordinate of the wall 

09 

pj 16 surface pattern corresponding to the node N 8 *i. 

M : 17 Then, the program goes to S206 where it is checked 

hi 

fbj 18 whether or not the node is the last one of the side wall group 

g 19 selected and if it is not the last node, the program goes back 

20 to S203 and the same processes are repeated. When the process 

21 reaches the last node, the program steps to S207 where the node 

22 having the smallest reference number (the node nearest to the 

23 self vehicle) and the node having the largest reference number 

24 (the node furthermost from the self vehicle), are searched 

25 respectively and leaves the routine after denoting them as a start 

26 point N 8 and an end point N e , respectively. 

27 After this program is carried out on the side wall 

28 groups on the left side, it is carried out on the side wall groups 
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on the right sTW. In the example shown in Fig^ 1 , the wall surface 
from the 9th node to the 26th node is detected on the right side 
of the self vehicle and the 9th node is denoted as the start point 
N 8 and the 26th node is denoted as the end point N e . These nodes 
are used for later processes as effective nodes. 

Thus processed position of the wall surface is further 
corrected by a program shown in Fig. 7 and Fig. 8 using new data 
obtained from programs shown in Fig. 3 through Fig. 5. 

The programs shown in Fig. 7 and Fig. 8 is a program 
for correcting the wall surface. At S301, it is investigated 
whether or not the start point N 8 of the effective nodes is larger 
than the first node Ni of the wall surface model. When N 8 = Ni, 
the wall surface has been already detected up to the first node 
Ni, the program skips to S306. When N s > N lf the program goes to 
S302 where the previous node N 8 .i (i - 1, 2, 3 etc.) is established. 
Then, at S303 the wall surface pattern is searched and at S304 
the X- coordinate of the wall surface is determined based on the 
result of searching. 

Next, the program goes from S304 to S305 where it is 
investigated whether or not the process has reached the first 
node. If not yet reached the first node Ni, the steps S302 to S304 
are repeated to continue the searching of the wall surface 
position up to the node Hi. When the processes up to the first 
node Ni are finished, the program goes to S306 where it is checked 
whether or not the end point N e of the effective nodes is smaller 
than the last node N 8e of the wall surface model (for example, 
node N«i in case of the wall surface model constituted of 41 nodes) . 

As a result of this, when N e = N Be , that is, the wall 
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surface has bIMl ready detected up to the lW" node, the program 
skips from S306 to 8311. When N e < N ae , the program goes from S306 
to S307 where the node N e -i after the end point N e is successively 
established and further at S308 the pattern matching of the wall 
surface is performed. According to the result of the pattern 
6 matching, at S309 the X-coordinate of the wall surface is 
determined and then at S310 it is checked whether or not the process 
has reached the last node N 8e . The matching of the wall surface 
9 position is continued until the last node N 8e and when the processes 
up to the last N ae is finished, the program goes to S311. 

These processes of establishing the nodes , the matching 
of the wall surface pattern and the determination of the X- 
13 coordinate at the steps S302 to S304 and the steps S307 to S309, 
y 14 are the same as the processes at the steps S203, 204 and S205 
j 15 in the aforementioned program of the wall surface detecting 
16 process. 

y* 17 The processes after S311 are for correcting the 

LjJ 18 position (X-coordinate) of respective nodes from the first node 
g 19 Ni to the last node N Be . First, at S311 the data of the first node 
^=20 Ni is set and the program goes to S312. The processes from S312 

21 to S321 are repeatedly carried out by successively setting the 

22 data of the next node. 

23 At S312, the wall surface at the node Ni is searched 
and at S313 it is checked whether or not the wall surface is 



25 detected by the pattern matching. If it is judged that the wall 
surface is detected, the program goes from S313 to S314 where 



27 it is investigated whether or not the difference between the 

28 position x P „ of the wall surface and the position X nl of the node 
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is within a piWcribed amount, for exampleT± 1 meter. If the 
difference is within the value, the program goes to S315 where 
the node is moved to the position of the wall surface (X ni <- x pw ) 
and if the difference is out of the value, the program goes to 
S316 where the node is moved toward the wall surface by a specified 

6 amount, for example, ± 0.3 meters (X ni <- x ni ± 0.3 meters). 

7 On the other hand, when the wall surface is not detected 

8 by the pattern matching, the program diverges from S313 to S317 

9 where the number Co of the data X pl of the solid objects located 
on the left side of the node X ni (x ni < X pi )and the number d of 

11 the data X pi of the solid objects located on the right side of 

12 the node X nl (X n i > X pi ) , are counted respectively. Then, at S318 
O; 13 the node is moved towards the side having more data of solid objects 
fy 14 by a specified amount, for example 0.8 meters (X n i <- X n i±0 . 8 
m 15 meters) . 

nJ 16 Thus, in case where there is no wall surface pattern 

\± 17 detected near the node, the position of the node can be neared 
nJ 18 in the direction where the wall surface likely exists even when 
g 19 the node is largely apart from the wall surface. 

20 When the position of the node is moved through either 

21 step of S315, S316 and S318, the program goes to S319 where a 

22 position X c of a mid-point of a straight line connecting a node 

23 Ni*i (adjacent node on far side) and a node Ni-i (adjacent node on 

24 near side) is obtained and then goes to S32 0 where, as shown in 

25 Fig. 18, the node Ni is moved toward the mid-point X c just like 

26 in a manner that the mid-point X c attracts the node Ni by a spring 

27 force. The amount of the movement should be retained as much as 

28 1/2 to 1/5 of the length between the node Ni and the, mid-point 
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2 That is, the wall surface detected by the pattern 

3 matching generally contains irregularity due to the effect of 

4 the dispersion of data but a real guardrail or real side wall, 

5 in most case, is smoothly curved along a road. The process at 

6 S320 is a means for obtaining a smooth curve by applying a spring 

7 operation as described above. As a conventional method of 

8 smoothing the configuration composed of nodes, a least square 

9 method is well known, however the aforegoing method using a 

10 spring operation is more advantageous in calculation speeds than 

11 such a conventional method. 

12 After that, the program goes to S321 where it is 
Q 13 investigated whether or not the process has reached the last node 

nj 14 Nse and if it has not reached the last node point, the program 

03 

09 15 returns to S321 after setting the data of the next node at S322 

ry 16 and the same processes are repeated. When the process at the last 

a 

y,ll node N se is finished, the program goes from S321 to S323 where 

nj 18 * s checked whether or not the amount of the movement comes 

gl9 within a threshold value (for example, ±0.1 meters) for all of 

= 20 the points. 

21 Further, if a node exceeding the threshold value is 

22 found, the program goes back to S311 and thereafter the correcting 

23 processes are repeated for all nodes from the first to the last. 

24 When the amount of the movement for all node points comes within 

25 the threshold value, the start point N fl and the end point N. within 

26 the detecting range of the nodes are obtained and the program 

27 leaves the routine . Through thus constituted program, erroneously 

28 detected data and others are corrected during repeated processing 
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1 and as a result^ffe configuration of the wall 





ilar to the actual 



2 wall surface is obtained. After the program is finished to be 

3 carried out with respect to the side wall groups on the left side, 

4 the program is carried out with respect to those on the right 

5 side. 



7 surface located from near to far along a curved road on the basis 

8 of the original image shown in Fig . 9 and the corrected wall surface 

9 model expressed on a X-Z plane is shown in Fig. 20. Comparing 

10 * this wall surface model with the one detected in the form of 

11 straight lines as shown in Fig. 13 , it is understood that the 

12 wall surface can be recognized up to far,. 

13 This wall surface model can be applied not only to a 

14 guardrail but also to a line of trees, walls of houses, an array 

15 of parked cars and other solid objects lined along a road and 

16 these objects can be detected as a series of wall surfaces. 

17 Therefore, it is possible to recognize the configuration of a 

18 road even in case of a road whose lane markers can not be recognized, 

19 for example a snow- covered road. 

20 While the presently preferred embodiment of the present 

21 invention has been shown and described, it is to be understood 

22 that this disclosure is for the purpose of illustration and that 

23 various changes and modifications may be made without departing 

24 from the scope of the invention as set forth in the appended claim. 
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Fig. 19 shows a result of the detection of the wall 
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